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摘 要: 针对 无 人 机 路 径 规划 问题 ， 建 立 了 具有 定常 非 线性 系统 、 非 仿 射 等 式 约 束 、 非 凸 不 等 式 约束 的 非 凸 控制 问 
题 模型 ， 并 对 该 模型 进行 了 算法 设计 和 求解 。 基 于 和 迭代 寻 优 的 求解 思路 ， 提 出 了 凸 优化 迭代 求解 方法 和 罚 函 数 优 化 
策略 。 前 者 利用 凹凸 过 程 (CCCP) 和 泰勒 公式 对 模型 进行 凸 化 处 理 ， 后 者 将 经 处 理 项 作为 惩罚 项 施加 到 目标 函数 中 以 
解决 初始 点 可 行 性 限制 。 经 证 明 所 提 方 法 严格 收 你 到 原 问题 的 区 arush-Kuhn-Tucker(KKT) 点 。 仿 真实 验 验 证 了 罚 函 数 
西 优化 选 代 算 法 的 可 行 性 和 优越 性 ， 表 明 该 算法 能 够 为 无 人 机 规划 出 一 条 满足 条 件 的 飞行 路 径 。 
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Penalty function convex optimization iterative algorithm and its application in UAV path planning 


Hu Kun, Zhang Liangi 
(School of Science, Wuhan University of Technology, Wuhan Hubei 430070, China) 


Abstract: This paper established a non-convex control model consists of time-invariant nonlinear system, non-affine equality 
constraint and non-convex inequality constrain aiming at the path planning problem of unmanned aerial vehicle (UAV) , along 
with an algorithm designed for solving the aforementioned model. Based on iterative optimization, it proposed the convex 
optimization iteration method and penalty function optimization strategy. The former uses the concave-convex process (CCCP) 
and Taylor formula to convexity the model, while the latter adds the processed term to the objective function as a penalty term 
to solve the feasibility limit of the initial point. It is proved that the proposed method strictly converges to a Karush-Kuhn- 
Tucker(KKT) point of the original problem. Simulation experiments result verified the feasibility and superiority of the penalty 
function convex optimization iteration algorithm, and it indicates that the proposed algorithm can provide a flight path 
satisfying the conditions for the unmanned aerial vehicle. 
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0 ”引言 可 以 通过 逐次 凸 化 0 的 方式 解决 : 对 于 某 些 非 上 四 控制 约束 的 
本 问题 ， 可 以 通过 无 损 凸 化 0 进行 凸 化 处 理 ;， 而 对 于 某 些 非 凸 
无 人 机 在 空中 航行 障碍 少 、 效 率 高 、 成 本 低 ， 可 广泛 应 状态 约束 问题 ， 也 可 以 用 连续 线性 化 逼近 09 的 方式 来 凸 化 。 
于 民用 以 及 军事 领域 , 壁 如 通信 、 物 流 、 导 弹 等 山 。 无 人 机 为 了 解决 无 人 机 的 路 径 规 划 问 题 ， 本 文 考虑 具有 定常 非 
的 路 径 规划 问题 是 其 中 的 核心 问题 ， 目 标 是 生成 从 起 点 到 目 线性 系统 、 非 仿 射 等 式 约束 、 非 凸 不 等 式 约束 的 最 少 燃 耗 控 
标点 的 实时 全 局 路 径 ， 避 免 与 障碍 物 的 碰撞 ， 并 在 运动 动力 制 问题 模型 。 在 本 文中 ， 本 文 的 工作 主要 分 为 三 部 分 : 
学 约束 下 使 性 能 指标 达到 最 优 户 。 a) 为 了 求解 原 问题 的 非 凸 最 优 控制 模型 , 利用 凹凸 过 程 
无 人 机 的 自 限 条 件 、 大 气 湛 流 、 环 境 局 部 信息 和 传感器 (concave-convex procedure，CCCP) 和 泰勒 公式 进行 凸 优化 处 
能 力 限 制 给 无 人 机 路 径 规划 和 优化 带 来 了 诸多 挑战 。 国 内 外 里 ; 
专家 学 者 针对 上 述 问 题 从 不 同方 向 提出 和 改进 了 航 迹 规 划算 b) 为 了 解决 泰勒 展开 线性 化 过 程 所 产生 的 初始 点 可 行 
法 Bl, 目前 主要 有 两 大 类 算法 : 智能 算法 和 数值 算法 。 智 能 算 性 限制 ， 将 经 处 理 项 作为 惩罚 项 施加 到 目标 函数 中 进行 罚 函 
法 如 遗传 算法 由、 蚁 和 群 算法 铝 、 粒 子 群 优化 算法 四、 动态 规划 数 优 化 ， 从 而 提出 罚 函 数 凸 优化 迭代 算法 ; 
算法 中 等 都 能 在 各 自 方面 达到 所 需 的 最 优 ， 但 也 存在 各 自 的 c) 对 算法 的 处 理 和 优化 过 程 进 行 收敛 性 分 析 , 证 明 所 提 
缺陷 。 比 如 ， 多 数 智能 算法 的 计算 量 、 编 码 难 度 、 时 间 复 杂 算法 收敛 到 原 问题 的 Karush-Kuhn-Tucker(KKT) 点 , 且 对 非 凸 
度 将 随 着 搜索 空间 的 增 大 、 网 格 步 长 的 缩小 、 节 点 数目 的 增 最 优 控制 问题 的 求解 具有 普 适 性 。 
加 等 因素 呈 指 数 增长 外。 最 后 通过 对 无 人 机 路 径 规 划 模 型 进行 仿真 实验 ， 表 明了 
相 比 而 言 ， 数 值 算法 所 取得 的 结果 具有 更 高 的 精确 度 。 所 提 算 法 能 够 收敛 于 一 条 满足 要 求 的 最 优 路 径 ， 适 合 复杂 地 
大 部 分 数值 方法 把 无 人 机 路 径 规 划 建 模 为 非 上 四 规划 问题 。 而 下 自动 驾驶 机 器 的 路 径 规划 问题 。 
由 于 非 四 问题 的 复杂 性 ， 传 统 的 庞 特 里 亚 金 最 小 值 原理 并 不 二 二 
能 有 效 解决 四 。 随 着 DC 规划 和 DCA 算法 00 的 提出 ， 越 来 越 1 罚 函 数 户 优化 运 代 算 法 
多 的 学 者 将 视线 投向 了 对 四 凸 性 方面 的 研究 。 凸 问题 可 以 在 1.1 非 凸 最 优 控制 模型 
多 项 式 时 间 内 可 靠 地 解 出 全 局 最 优 解 00。 常 见 的 凸 问题 求解 本 文 考 虑 非 凸 最 优 控制 模型 如 下 : 
器 有 MISER3023、ECOS03] 等 。 通 常 来 说 ,， 非 凸 性 是 由 非 线性 min yl[ em 
动力 学 、 非 凸 状态 、 非 凸 控制 约束 引起 的 。 对 于 非 线性 系统 ， 六 Oh ol OF WY 
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SL. X(t)= A(t)x(t) + B()u(?), (2) 
xi(t)eX; ER (DEL SR， (3) 
x(10)=m, x(ti)=xy, (4) 
si[(x(0),u(D), <0. (5) 
其 中 ,， 式 (1) 表 示 燃 料 总 量 ，w() 为 m 维 控制 向 量 u(7) 的 各 个 


分 量 (j=42.…m) ，C 为 比例 系数 (C;>0)。 式 2) 表示 非 线 性 时 
不 变 系统 的 状态 方程 ，x(?) 为 4 维 状态 向 量 ，4 为 xxn 和 矩阵 ， 
8 为 nxm 和 矩阵 。 式 (3) 表 示 状 态 和 控制 约束 ，*(?) 为 x(?) 的 各 
个 分 量 (j=42,…,n) 。 式 (4) 表 示 初 始 和 终端 状态 。 式 (5) 表 示 非 
线性 非 凸 不 等 式 约束 ， 函 数 至少 二 阶 连续 可 微 ，i=b.…n, 。 
1.2 凸 化 处 理 
已 知 凸 优化 问题 需 满足 三 个 要 求 : 目标 函数 为 凸 的 ;不 
等 式 约束 函数 为 凸 的 ， 等 式 约 束 函 数 为 仿 射 的 09。 

不 失 一 般 性 ， 问 题 (P0) 可 以 写成 标准 形式 的 非 线性 优化 


问题 : 


(P1): min fo(z), (6) 
st. fi(z)<0, i=1,...,g, (7) 
h(z)=0, i=1,...,p, (8) 

zeZ. (9) 


其 中 ，z=[xuJ exXxv ， 式 (6) 是 仿 射 的 ; 式 (7) 是 非 凸 的 ， 式 (8) 
是 非 仿 射 的 。 并 且 fi 与 h 均 为 二 阶 可 微 , 式 (9) 是 可 行 域 约束 。 
对 于 非 凸 不 等 式 约 束 ， 根 据 凹 凸 过 程 (CCCP)08 的 思想 ， 
将 具有 有 界 Hessian 和 抢 阵 的 函数 f(z) 表示 为 同 函 数 fi 与 四 
函数 jw 的 和 ; 


fiva (TZ)+ fivwe(z) sO0, i=1,...,g. (10) 
这 个 分 解 不 唯一 。 当 fi 在 第 次 迭代 解 、 参 数 向 量 x 
附近 二 阶 连续 可 微 时 ， 基 于 和 迭代 寻 优 的 求解 思路 ， 在 x 处 一 
阶 泰勒 展开 线性 化 处 理 ， 得 到 如 下 不 等 式 约束 : 
fiver (Z) + frome (Ze) + VHT (ze)(z—a)<s0, i=L,...,g. (11) 
其 中 ，fiwa( 引 为 是 函数 ，ficac(3)+VW(z)(z-) 为 仿 射 函数 ， 则 
式 (11) 为 凸 不 等 式 约 束 。 
对 于 非 仿 射 函数 及 (z) ， 当 其 在 x 附近 二 阶 连续 可 微 时 ， 
点 用 泰勒 公式 得 到 线性 近似 项 : 
h(a)+Vh (za)(z—a)=0, i=1,...,p. (12) 
仿 FB(sa)= fe (T+ ficmelz) + VT (zi) (zz), H(z;a)= 


江上 晃 


z ， 则 有 如 下 连 代 优化 处 理 模型 : 
(P2): min fh(z), (13) 
SL. F(zz)<0, i=1,...,g, (14) 
Hi(ziz)=0, i=1,...,p, (15) 
zeZ, (16) 
|z—zlse. (17) 


其 中 , 目标 函数 hh(z) 是 仿 射 的 , 不 等 式 约束 函数 (z;z) 是 是 
的 ， 等 式 约束 函数 Hi(z;a) 是 仿 射 的 ， 式 (16) 为 可 行 域 约束 ， 
式 (17) 为 信赖 域 约束 ，2 为 常数 。 因 此 ， 问 题 (P2) 是 凸 优化 问 


日 


题 。 
1.3 收敛 性 分 析 
引 理 1 若 凸 问题 (P2) 有 极 小 点 z* ， 则 迭代 过 程 单调 非 


增 且 收敛 。 

证 明 因为 问题 (P2) 有 极 小 点 z* ， 即 对 任意 ， 
万 (z)>inf fh(z)=h(z*) ,所 以 {有 (zi 有 下 界 。 又 知 缀 是 第 -1 
次 从 代 的 最 优 解 ， 是 第 k 次 迭代 的 初始 解 ， 而 zw 是 第 次 迭 
代 的 最 优 解 ， 因 此 有 (zn)<h(a)。 所 以 {ho(z 少 单调 非 增 ， 
且 有 下 界 ， 得 {z(zjj} 单 调 非 增 且 收敛 。 

引 理 2 山 问 题 (P2) 的 迭代 序列 {a} 收敛 到 其 KKT 点 z*， 


即 和 一 一。 
证 明 ”因为 凸 问题 必然 有 且 仅 有 一 个 极 小 点 z* ， 结 合 引 
理 1 知 凸 问题 (P2) 单 调 非 增 且 收敛 ,并 且 收 和 敛 到 这 个 KKT 点 。 


定理 1 原 问 题 (P1) 的 全 局 极 小 点 也 是 是 问题 (P2) 的 全 
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局 极 小 点 ; 凸 问题 (P2) 的 全 局 极 小 点 是 原 问 题 (P1) 的 KKT 点 。 
证 明 a) 若 x 是 原 问题 (PH) 的 全 局 极 小 点 , 则 对 vzszZ ， 
有 f(a)<f(z)， 即 : 

fiver (Zk) + fivme (Ze) < fiver (2) + ficme (2). 
因为 fe 有 半 负 定 Hessian 矩阵 ， 所 以 : 


芝 


于 是 有 : 
Fcc) = five (za) + ficae (zr) + VHT, (ze) (zx — zx) 
= fiver (Ze) + ficae (ze) < fiver (Z) + ficaelz) 
< fiver (Z) + frowelZi) + VT, (ze)(z—z)= (zz). 
因此 ， 是 凸 问题 (P2) 的 全 局 极 小 点 。 
b) 假设 凸 问题 (P2) 的 全 局 极 小 点 为 & ，(z*,X,0') 为 其 
KKT 点 ， 则 满足 KKT 条 件 : 


z 
又 因为 全 局 极 小 点 必 为 KKT 点 ， 即 =z ， 结 合 
fivar (Z) + ficare (2) =f (z) 可 得 : 
F(a) <0, 1 
h(z)=0, i=1,...,p, 
>=0, [A 


Rfi(z)=0, i=b..,p, 


V(t DAV a) + Pov) =0. 


此 即 为 原 问 题 (P1) 的 KKT 条 件 ， 因此 是 原 问题 (P1) 的 
KKT 点 。 

定理 2 凸 优 化 过 程 (P2) 全 局 收 全 到 原 非 凸 最 优 控 制 问 
题 (P1) 的 一 个 KKT 点 。 

证 明 从 初始 点 as2Z 出发, 凸 问题 (P2) 会 得 到 一 个 迭代 
点 列 {z} 。 

a) 若 { 引 收 化 ,假设 品 %* 。 第 二 次 和 帮 代 
fe (Dt fiome(o)t Va)(z- 书 )<0, 假设 xz 是 其 全 局 最 优点 , 则 : 


Fier Zar) + fisae zn) + VHT (zz 一 oo) 
< fiver (Z) + ficae(zn) + VAT (z1)(z—z,). 


不 等 式 两 边 同 时 取 极 限 ” + ， 得 : 


faa (2 ) + foe(z ) + VT CD(z 2) 
< fivor (Z) + fionelz)+ VT (2)(z—z°). 


对 任意 zeZ 成 立 ， 因 此 是 凸 问题 P2) 的 全 局 极 小 点 ， 
结合 定理 1，xz* 是 原 问 题 (P1) 的 KKT 点 。 

b) 若 {z} 发 散 ， 由 于 凸 问题 (P2) 有 下 界 ， 根 据 魏 尔 斯 特 
拉 斯 聚 点 定理 ， 在 有 界 点 集 fx } 内 至 少 有 一 个 聚 点 ， 假 设 为 
z*。 由 此 在 {z} 中 存在 子 列 {z} 收敛 于 xz , 且 是 凸 问题 (P2) 
在 {z} 内 的 最 优点 。 此 问题 通过 反 证 法 证 明 : 假设 六 不 是 原 
问题 (P1) 的 KKT 点 ， 则 对 任意 充分 小 5>0 ， 存 在 原 问题 (P1) 
的 可 行 点 2 ， 有 上 -zl<6 ， 且 fi( 引 <fi(z*) 成 立 。 因 此 有 
fi(2)-f(z2)=Vf(z")(2-2")<0 Ep: 

Vfiver (z” )(Z—2°)+ Vficme lz” )(Z—2z") 
= fiva (2)— fiver (ZT ) + Vhicme(z” )(zZ—z*)<0. 

从 而 : 

F(z )=h(z" )= fr (2)+ fe (2 ) 
+Vfiome (2” )(Z—2")— fiver(z”)— ficwe lz" )<0. 

这 表明 存在 一 个 充分 靠近 六 的 点 z， 使 得 :在 凸 问题 (P2) 
内 的 值 小 于 z*， 这 与 是 凸 问 题 (P2) 的 最 优点 矛盾 ， 因 此 假 
设 不 成 立 ，z* 是 原 问 题 (P1) 的 KKT 点 。 

综 上 所 述 ， 凸 优化 过 程 (P2) 全 局 收敛 到 原 非 凸 最 优 控 制 
问题 (P1) 的 一 个 KKT 点 。 

1.4 罚 函 数 优化 
凸 优化 过 程 采 用 了 泰勒 公式 近似 线性 化 的 方式 ， 在 约束 
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函数 尤其 是 等 式 约束 中 进行 了 二 阶 项 舍弃 。 因 此 存在 着 一 些 
不 可 行 初始 解 导 致 无 法 收敛 的 情况 。 为 了 解决 上 述 问题 ， 本 
文 对 凸 优化 问题 (P2) 进 行 罚 函数 优化 。 通 过 对 不 可 行 迭 代 点 
施加 惩罚 迫使 迭代 点 向 可 行 域 靠近 ， 从 而 降低 对 初始 点 选取 
的 可 行 性 要 求 。 

对 于 凸 问题 (P2)， 令 五 (5z) =max{0 瑟 zz， 将 经 处 理 项 
作为 惩罚 项 施加 到 目标 函数 中 得 到 罚 问 题 : 

(P3): min OD)+o{SLr (sa) +E (a) (18) 


所 


SL. zeZ， (19) 
lz-zlse. (20) 
其 中 ，o>0 为 惩罚 因子 ，Q,B8>1。 对 于 罚 问题 与 原 约束 优化 


问题 的 关系 ， 有 如 下 定理 : 

定理 3 设 z 是 凸 问题 (P2) 的 全 局 极 小 点 ， 罚 因子 序列 
{9x} 发散 到 +% , 若 z 是 罚 问 题 (P3) 的 全 局 极 小 点 , 则 罚 问题 
(P3) 的 聚 点 z 收 敛 到 原 问题 (P1) 的 KKT 点 。 


证 明 SP)= Sea)T + laa » P(z,0)=f(zs)+oB(z,) o 


对 任意 ob>o0,>0， 设 z 和 zo 分 别 是 罚 函 数 P(z,o) 对 应 于 a 
和 o; 的 最 优 解 ， 则 : 


Re) +r osB(es) 2 hs) + Plz), 
fo(zo,)+oP(zo,)> f(zo)+oP(z, ). 


式 相 加 得 (w=-o)[(s)-P()]>0 ， 由 os>o 知 
B(z)>P(z,) ,因此 F(z,) 关 于 o 单调 不 增 。 由 上 面 第 二 式 得 : 


fo(za) -f(za)>o|P(zs)-P(z,,)|>0, 
P(zo,,03)= f(z0,)+ 05P(z,,) 
= f(za)+oP(z)+(0 -0)P(z,) 
> f(z )+oB(z, )=P(z,0). 


此 (zs) 和 P(zs,o) 关 于 o 单 调 不 减 。 
由 z 是 凸 问题 (P2) 的 全 局 极 小 点 及 是 罚 问 题 (P3) 的 全 
局 极 小 点 知 z 与 zx 均 为 可 行 点 , 即 E(z)=0 ，B(z)=0。 于 是 有 : 
f(zo)= f(zo ) +o.P(z, )=P(z,,07) 

<P(z',0.)= f(z)+oB(z)= f(z"). 


则 (zs) 和 P(zs,o) 关 于 o 有 界 ， 因 此 极限 均 存 在 ， 设 为 


By 


f° 和 p"。 于 oo > +00 ， 得 : 
P 二 
lim Bl ) = fim Sa) hola) 0 
大 一 +oo 人 一 >+oo Ox 
对 于 聚 点 z，, 有 纪 5， 则 PB(z)=0, 因此 z 为 可 行 点 。 又 


因为 z* 是 凸 问题 (P2) 的 全 局 极 小 点 ， 所 以 h(z*)< hh(z)。 再 对 
矿 (za)<h(z') 两 端 取 极限 得 及 (z)s<h(z*)。 因 此 有 (z)= 有 h(z*)， 
即 聚 点 z 是 凸 问 题 (P2) 的 全 局 极 小 点 。 结 合 定 理 2 知 壹 收敛 
到 原 问 题 (P1) 的 一 个 KKT 点 。 


下 面 给 出 基于 上 述 过 程 的 罚 函 数 凸 优化 迭代 算法 伪 代 码 : 


算法 1 罚 函 数 凸 优化 迭代 算法 

a) 输入 参数 : 终止 时 刻 '/ ， 约 束 参 数 ， 容 许 误差 6 ， 惩 
罚 因 子 c ， 最 大 友 代 次 数 em ; 

b) 离散 化 : 对 模型 总 时 长 1 关于 时 间 步 长 At 划分 为 N 
个 离散 节点 N=w/At; 

c) 初始 化 :选取 任意 初始 点 ; 

d) 线性 化 : 式 (14)(15); 

e) 办 代 寻 优 : k=1:: 求 得 相应 的 目标 泛 函 ; 

f) 循环 : 若 x 一 |>s ， 则 转 步 马 g)， 否 则 转 步 骆 h); 

8) 更 新 : 上 < 二 t+1， 转 步 又 人 ; 

h) 输出 : 最 优 值 % 。 
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2 ”仿真 实验 与 结果 分 析 


将 总 时 长 按照 节点 间距 A1=w /WN 离散 化 为 YX 个 节点 ， 
建立 无 人 机 的 路 径 规 划 模 型 : 


BD: min Ph tw OF) + or Cem), CD) 
SL, 

y(i)= Ay(i)+B(u(i) + 8),i=1.,N, (22) 

y(ijeX ccR",u(i)eU Cc RW",i=1,...,N, (23) 

y(D)=y0, y(N)=y;- (24) 


其 中 ， ow 和 0%, 分 别 对 应 燃 耗 和 路 径 长 度 的 权重 系数 ， 
(4). =max{0,f(A%)}} ，o 为 惩罚 因子 ， 


人 ep 。 


本 文 将 障碍 物 视 作 圆 柱状 ， 只 考虑 从 圆 形 侧面 绕 过 ， 而 
不 从 项 部 飞越 。 


Fi)=7(D) -I (Dc( N= 


[x (CD)-c(C H 
TO] 
i=1.N, j=1.,M. 
表示 将 非 凸 避 障 约束 2x(i)-c( 首 27( 站 通过 所 提 算 法 优 
化 后 的 不 等 式 约束 函数 ，c( 站 、r(j) 分 别 表示 第 j 个 障碍 物 的 
坐标 和 半径 ，M 是 障碍 物 总 数 。 
X={(x(D),v()) eR | OO SV 
U={ueR™|firu(i) 2lu (Dl, coso,lul, < Ua} 
其 中 ， ws 和 Us 分 别 表示 为 速度 上 限 和 加 速度 上 限 ， 并 且 
Uswx=Fa/m ， Fw 为 最 大 推力 、m 为 飞行 器 质量 ; 
iu(i)> 有 ucos9 表示 推力 角 约 束 ，9 为 推力 角 ，4=[0%o1 为 指 
向 z 轴 正方 向 的 单位 向 量 。y(1)=y。，3Y(N)=y/ 为 起 始 和 终止 


[x(7) -x ()], 


下 面 通过 仿真 实验 验证 所 提 算 法 在 无 人 机 路 径 规 划 模 型 
中 的 可 行 性 和 优越 性 。 仿真 实验 均 在 Windows 7 操作 系统 中 
的 Matlab R2017b 环境 下 进行 , 硬件 环境 为 Intel(R) Core(TM) 
i3-5005U CPU @ 2.00GHZ 处 理 器 且 安 装 内 存 为 4GB 的 PC 
机 ， 并 且 在 求解 过 程 中 调用 了 CVX09] 工 具 箱 。 

对 于 所 提 算 法 的 可 行 性 问题 , 设置 实验 参数 如 表 1 所 示 。 


Tab. 1 _ Experimental parameter table 
参数 值 参数 值 
N 100 At 1 S 
Vnax S50m/s Fnax 40N 
m 4kg emax 10 
0 100 0 30° 
n [0,0,1]" & [0,0,-9.81] "m/s 
Ou 1 Cr 1 
8 103 


规划 空间 D=feyalosrys<lo00om ， 起 始点 为 
Xx(1)=(0,0,0) , 终止 点 为 x(N)=(1000,1000,2.4) ， 并 选择 起 、 止 点 
的 连 线 作为 初始 路 径 。 令 初始 速度 为 v(D)=(0,0,0) ， 终 止 速度 
为 v(N)=(0,0,0) , 起 始点 仅 有 向 上 的 加 速度 w()=(0,0,0)， 燃 
耗 量 用 加 速度 的 二 范 数 > 等 比 普 换 。 实验 结果 如 图 1 


和 2。 


图 1 可知， 所 提 算 法 可 以 在 复杂 环境 下 实现 无 人 机 的 
二 维 、 三 维 路 径 规 划 ， 并 且 不 受 初始 路 径 可 行 性 限制 。 观 察 
2 发 现 ， 在 第 二 次 迭代 时 ， 路 径 长 度 和 燃 耗 都 已 经 接近 最 
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优 了 ， 所 以 在 实际 处 理 时 可 以 适当 增 大 容许 误差 = 或 者 降 
迭代 次 数 上 限 bs 以 节省 时 间 成 本 。 
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CO 本 人， 
a00 一 一 、 一 
5 
( ) SO 
0 \ / EN 
和 ~ (未 a 2 
入 
00 人 ) E 
WR “1 t000 
aol (7 1 人 一 
es We We \ ~ 
We oa 


0 es 
200 — 
400 go0 
xim® 800 100 0 


(b) 三 维 路 答 


图 1 无 人 机 罚 函 数 凸 优化 迭代 算法 的 规划 路 径 
Fig. 1 The planning path of penalty function convex optimization 
iterative algorithm for UAV 
Ri Ce 4 | Ce 4 
(a) 路 径 长 度 随 达 代 次 数 变 化 (b) 燃 耗 随 近 代 次 数 变化 
图 2 三 维 情 况 的 路 径 长 度 与 燃 耗 量 随 过 代 次 数 变 化 图 


低 


Fig.2 The path length and fuel consumption vary with the number of 


iterations in the three-dimensional case 
为 体现 算法 优越 性 ， 本 文 将 对 比 三 个 常见 的 路 径 规划 
能 算法 : 遗传 算法 、 蚁 群 算法 和 动态 规划 算法 。 为 满足 对 


智 


比 


算法 可 行 性 需求 ， 对 起 始点 作出 调整 ， 相 应 的 缩小 了 第 一 个 
圆 形 障碍 物 的 半径 ， 并 对 各 项 数值 等 比 调整 。 在 设置 相同 节 


点 数 的 情况 下 进行 实验 ,网 格 步 长 为 0.25km, 节点 数 均 为 3 
实验 结果 如 图 3。 


x/km 
图 3 对 比 实验 
Fig.3 Contrast experiment 
规划 路 径 长 度 对 应 遗传 算法 、 蚁 群 算法 、 动 态 规划 算法 
本 文 算法 分 别 为 15.9541 km、13.6725 km、13.5432 km 


13.3255 km。 
且 ， 一 方面 ， 本 文 算法 不 需要 如 蚁 群 算法 和 动态 规划 算 
一 般 将 规划 空间 网 格 化 ， 所 规划 出 来 的 路 线 更 加 平滑 ， 更 
合 实际 飞行 。 另 一 方面 ， 也 不 会 如 蚁 群 算法 和 遗传 算法 一 
规划 结果 出 现 波动 、 存 在 随机 性 ， 所 规划 路 径 更 加 稳定 ， 


适合 实际 应 用 。 


7， 


、\ 


二 


结果 表明 ， 所 提 算 法 可 以 规划 出 更 短 的 路 径 。 


法 
符 


更 


3 ”结束 语 
为 了 解决 无 人 机 路 径 规划 问题 ， 本 文 从 最 优 控制 的 角度 
出 发 ， 提 出 了 求解 非 凸 最 优 控制 问题 的 罚 函 数 凸 优化 迭代 算 
且 不 受 


法 。 所 提 算 法 经 证 明 严 格 收敛 到 原 问 题 的 KKT 点 ， 
初始 点 可 行 性 限制 。 仿 真实 验 验 证 了 所 提 算 法 在 无 人 机 路 
规划 问题 中 的 可 行 性 和 优越 性 。 


pa 
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